uint8 id_num
uint8 joint_num
float32 angle
float32 speed
float32 angle_err
float32 speed_err
float32 torque